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'This  papar  addrasaas  tha  lssua  of  target  tracking 
whan  confronted  with  a  set  of  sound  spasd  parameters 
that  are  partially  or  eonplataly  unknown.  It  explores 
tha  case  where  these  parameters  are  augmented  to  the 
target  state  In  an  extended  Kalman  filter.  The  filter 
processes  measurements  of  sound  tine-of "arrival  differ¬ 
ence  and  Doppler  difference  from  a  sat  of  spatially 
displaced  sensors. 

For  scenarios  Involving  up  to  three  sensors  It  has 
been  found  that  biased  target  position  estimates  and 
marginal  system  observability  occurs.  This  Is  readily 
verified  by  propagating  the  eigenvalues  of  the  infor¬ 
mation  matrix  In  time.  Using  this  as  an  analysis  tool, 
a  number  of  geometrical  sensor  configurations  are 
analysed. 

In  general.  It  la  found  that  with  three  sensors,  the 
system  Is,  st  best,  marginally  observable  for  any  geom¬ 
etry.  However,  when  using  four  and  more  sensors,  sys¬ 
tem  observability  and  estimation  performance  are  markedly 
Improved  when  two  of  the  sound  spaed  filter  parameters 
arc  specified  to  within  a  close  tolerance  of  their 
actual  values.  When  attempting  to  estimate  all  of  the 
sound  speeds  (or  for  chst  matter  (n-l)  sound  speeds, 
n  •  number  of  sensors).  It  la  again  noted,  as  In  the 
three-sensor  ease,  that  system  observability  and  estima¬ 
tion  performance  become  degraded. 


1 


Introduction 


la  a  target  tracking  application,  one  reason  for  poor 
estimation  performance  can  be  a  lack  of  knowledge  con¬ 
cerning  the  parameters  of  the  mathematical  model  that 
relates  the  target  state  to  the  measurements.  Since  a 
mathematical  model  la  a  necessary  Ingredient  to  any  tar¬ 
get  cracker  or  state  estimator,  use  of  Incorrect  parame¬ 
ters  could  lead  to  estimates  that  diverge  from  "truth" 
over  a  period  of  time. 

It  la  this  problem  that  Is  dsalt  with  In  this  paper. 
More  specifically.  It  Involves  a  target  tracking  prob¬ 
lem  where  measurements  of  time  difference  and  Doppler 
difference  arc  collected  from  pairs  of  spatially  dis¬ 
placed  sensors.  The  central  issue  is  that  the  sound 
speeds  from  the  target  to  each  of  these  sensors  are 
partially  or  completely  unknown.  These  speed  parameters 
appear  In  the  mathematical  model  relating  the  target 
stats  to  the  measurements.  To  avoid  biased  target 
tracks,  some  mechanism  should  be  found  to  accomodate 
these  parameter  uncertainties. 

The  material  In  this  paper  la  basically  an  extension 
of  an  earlier  work  (1)  and  Is  more  conclusive  In  terms 
of  the  results  that  were  obtained  for  a  number  of  dif¬ 
ferent  geometric  scenarios  Involving  sensor  placements 
and  target  location. 

He  will  start  our  discussion  In  Section  2  by  describ¬ 
ing  the  mathematical  model  for  the  given  process  and 
proceed  to  define  an  estimator  that  can  accomodate 
both  unknown  sound  speeds  and  the  target  state  vector. 
All  of  the  simulation  results  will  be  presented  In 
Section  3.  In  addition,  we  will  also  show  how  we  can 
assess  system  observability  via  the  Information  matrix. 
This  will  play  a  useful  role  In  exploring  system  observ¬ 
ability  for  a  nuabar  of  different  target/tensor  geome¬ 
tric  scenarios. 


From  tha  simulation  results  it  will  be  soon  that  a 
minimum  number  of  sensors  are  needed  end.  In  addition, 
two  of  the  sound  speeds  must  be  known  correctly  before 
accurate  estimation  of  the  target  state  can  be  achieved 
Finally,  In  Section  A,  a  summary  of  the  results  and 
conclusions  will  be  presented. 


2.  System  Definition 


One  area  where  the  uncertain  model  parameter  problem 
could  arise  Is  depicted  In  Figure  1.  It  could  equally 
well  apply  to  tracking  of  vehicles  on  the  Earth  via 
geophones  or  any  place  that  the  signal  does  not  travel 
with  an  Infinite  effective  or  known  velocity.  He  have 
a  set  of  1  spatially  displaced  sensors  (distance  to 
target  ■  RA).  If  the  target  generates  or  reflects  sound 
st  time  Instant,  t,  because  of  the  sound  travel  time  to 
each  sensor  (sound  speed  -  cj),  it  will  be  sensed  at 
each  sensor  at  times  ti,t2,...,ti.  In  addition.  If  the 
target  moves  at  a  velocity,  v,  the  Doppler  sensed  at 
each  sensor  will  be  different.  To  estimate  the  target 
state,  i.e.,  position,  speed,  and  course,  measurements 
of  sound  time-of-arrlval  difference  and  Doppler  differ¬ 
ence  for  a  sensor  psir  1-J  (i,J»l,2,3,...,i«rJ)  can  be 
processed  through  s  Kalman  filter.  Using  spherical 
geometry,  these  measurements  can  be  related  to  the  tar¬ 
get  stats  by  the  following  equations  [1): 
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where 


Ra  "  coe^feinXjSinXj  +  cosxjCosXjCosUj-fi^)]  (3) 


XjIelnXjCoeX^osfXj-Bj^  -  cosx^slnX^] 
sin 


x^eosx  j  cosX^aln (x^-B^) 
sin 


(A) 


In  the  above  equations,  xi, 1*1,2, 3, A  represents  the 
target  latitude,  longitude,  latitude  rate,  and  longitude 
rate,  respectively.  The  latitude  and  longitude  of 
hydrophone  1  Is  XA  and  8j.  An  Implicit  assumption  In 
(A)  Is  that  the  sensors  are  stationary. 

Throughout  the  paper  we  will  take  the  target  state 
vector  to  be  x?  -  [x1.x2.x3.x4).  The  reason  for  doing 
this  is  that  target  motion  can  be  described  by  a  linear 
set  of  equations.  In  discrete-time  for*,  the  equations 
for  the  target  dynsnles  are  glvan  by: 


I 

0 

At 

n 

0 

’  *,<k)’ 

0 

1 

0 

At 

Wj(k) 

X(k+1)  - 

0 

0 

1 

0 

*<k)  <*■ 

*j(k) 

0 

m 

p 

0 

1  __ 

v.(k) 

4  « 

♦  (At)  «<k) 


whir*  At  •  Mipllni  Interval;  i.i.,  thi  t  1m  between 
measurements  of  7l)»flj:  w(k)  1*  a  zero- mean,  white 
nolii  victor  sequence  that  perturb!  the  target  froo 
othirwlai  constant  course/epeed  action;  and  where 

E{w(k)  0*0))  -  Qk  «kJ  . 


It  la  a  alapli  matter  to  display  apaid  and  courae  at  any 
tine  by  ualng  the  equation*  below: 


(6) 

(7) 


Since  the  aiaiureaint  model  la  nonlinear  (eq.  1-4), 
on*  can  laplimint  an  extended  Kalman  filter  to  track  or 
obtain  estimate*  of  the  target  atate  vector.  x(k).  This 
Is  easily  done  by  linearising  the  measurement  equation* 
about  the  most  current  state  estimate,  $(k) ,  to  obtain  a 
linear  measurement  equation,  H(x(k)).  The  equations  for 
the  filter  are  standard  (2]  and  are  summarised  below: 


5(fcHA)  -  A(At)  x(k/k)  (8) 
P(k+l/k)  -  A (At)  P(k/k)  AT(At)  +  Qk  (9) 
S(k+l/k+l)  -  S(k+1A)  +  kk+1I*(k+l) 

-  h(£(k+l)A))I  (10) 
P(k+1A+1)  -  (1  -  kkH(S(k+l/k))J  P(k+l/k)  (11) 
K^j  -  P(k+I/k)  H(i(k+l/k))  (H(5(k+l/k)) 

P(k+l/k)  HT(fi(k+l/k))  +  J^]"1  (12) 
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From  (1),  (2),  (13),  end  (14)  It  1*  easy  to  see  how 
sound  speed,  e*.  enters  Into  the  measurement  model.  In 
(1],  It  was  shown  that  when  Incorrect  values  of  c^  were 
used  In  the  filter  model  (aaaumlng  on*  did  not  know  the 
true  eg),  the  reeultlng  state  estimate*  were  found  to  be 
biased  off  from  the  true  target  atate.  In  seen  cases 
these  biases  were  significant,  and  consequently  the 
deviation  from  truth  was  as  significant. 

To  compensate  for  this  problem,  eh*  sound  speeds  were 
treated  as  additional  state  variable*  and  augmented  to 
the  target  state.  Since  the  sound  speeds  were  constant 
over  the  estimation  Interval,  the  state  dynamics  were 
simply  defined  by  A<  *  0.  The  extended  Kalman  filter 
was  then  implemented  for  this  augmented  state  vector  to 
generate  estimates  of  both  the  target  state  and  the 
unknown  sound  speeds. 

In  the  next  section,  wo  will  summarise  some  of  the 
earlier  result*  that  were  obtained  and  then  present  nor* 
exhaustive  results  that  Indicate  a  definite  trend 
occurring. 


3.  Simulation  geeulte 

To  examine  the  effects  of  estimating  unknown  sound 
speeds,  we  selected  a  number  of  different  casern  involv¬ 
ing  different  target  motion  scenario*  and  three-sensor 
configurations  as  shown  in  Figure  2. 

The  locations  of  the  sensors  are  defined  In  Tabic  1 
and  the  target  motion  scenario*  (cases  1-24)  are  sum¬ 
marized  in  Table  2. 


Table  1.  Location  of  sensors. 


Array 

Latitude,  X 

Longitude,  C 

1 

5  deg 

0  deg 

2 

-2.5  deg 

4.33  deg 

3 

-2.5  deg 

-4.33  deg 

Table  2. 

Target  motion  scenarios. 

Case  Starting  Position 

Number  Latitude  Longitude  Speed 

Course 

He  made  the  following  assumptions: 

(a)  The  covariance  matrix  of  the  dlscrete-tlm 
process  dynamics  was  defined  by: 
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where  433  *  q^4  *  (.0091127)  knote/eee  le  the  power 
spectral  density  of  the  random  nolee  perturbing  the 
velocity  etete  equations  of  the  continuous  eye tea.  This 
rendoaneee  in  the  target  velocity  for  the  continuous 
systea  translates  both  into  a  position  and  velocity 
uncertainty  in  the  equivalent  discrete-tins  nodal.  The 
values  of  q«j  and  444  roughly  correspond  to  a  standard 
deviation  of  .34  nautical  alias  in  position  and  .6  knot 
in  velocity  over  a  tine  interval  of  one  hour  In  the 
discrete-tine  aodel. 

(b)  The  neaaurenent  natrlx  covariance  matrix  was 
defined  by: 


(c)  it-300  sec  was  the  noalnal  tlae  Interval  between 
neasurenents. 

(d)  The  filter  processed  neasurenents  froa  the  sensor 

pairs  in  a  sequential  nanner  starting  with  sensor  pair 
1-2.  1-3,  2-3,  1-2.  1-3 . etc. 

(e)  The  sound  speeds  fron  the  target  to  each  of  the 
sensors  were  chosen  as  (3]: 

Cj  -  4857  ft /see 
Cj  -  4850  ft/aec 
Cj  -  4870  ft/sec 

He  scarted  out  by  sssunlng  that:  first,  only  one  of  the 
three  sound  speeds  was  unknown  and  consequently  was  estl- 
aated  along  with  the  target  state;  second,  two  sound 
speeds  were  unknown  and  were  estimated  along  with  the 
target  state;  and  third,  all  three  sound  speeds  were 
unknown  and  eatlaaced  along  with  the  target  state.  In 
all  of  these  cases,  it  was  found  that  biased  estimates 
were  generated  by  the  tracker.  A  typical  exaaple  of  thle 
le  shown  in  Figures  3,  4,  and  5  where  an  attempt  was  aade 
to  estimate  the  unknown  sound  speeds  and  the  target  state. 
The  solid  curves  represent  the  truth  aodel  whereas  the 
dashed  curves  represent  the  state  eatlaates.  Note  the 
significant  biases  in  latitude  and  longitude  in  two  of 
the  sound  speeds. 

Because  of  these  biases,  it  was  decided  to  examine 
the  observability  of  the  syatea  for  all  of  the  cases 
defined  in  Table  2.  This  la  easily  dons  with  the  aid 
of  the  lnforaatloh  aatrlx  (2],  For  the  case  involving 
no  process  noise  and  state  vector  a  priori  information, 
the  information  aatrlx  is  identical  to  the  Inverse  of 
the  Kalman  filter  covariance  aatrlx,  P~l(k/k).  This 
aatrlx  aust  be  positive  definite  for  stochastic  observ¬ 
ability  and,  provided  the  above  conditions  apply,  is 
given  in  recursive  fora  by: 

F_1(k/k)  -  ♦Vdt)  F-1(k-l/k-l)  (-80 

♦  HT(x(k-l))  l^-Woc-l)); 

f"1 (0/0)  -  0  (13) 

where  9(8t)  le  the  state  transition  aatrlx  defined  in 
(5),  HOr(k-l))  is  the  aeasureaent  aatrlx  linearised 
about  the  state  vector  x(k-l). 

To  asaess  the  property  of  stochastic  observability, 
the  normalised  eigenvalues  of  this  matrix  were  computed 
(normalised  to  one)  and  plotted  aa  a  function  of  tlae. 
Figure  4  shows  the  results  that  were  obtained  for  case 
11  in  Table  2.  One  of  the  position  eigenvalues  becomes 
111-condltlened  and  exhibits  a  smaller  maxima  magni¬ 
tude  than  the  other  position  eigenvalue  by  a  couple 
orders  of  magnitude.  This  analysis  was  repeated  for  all 
of  the  other  23  cases  and  the  same  general  result  was 
obtained,  l.e..  Ill-conditioned  behavior  of  one  of  the 
eigenvalues.  Because  of  this  end  the  fact  that  the 
state  estlsmtes  were  biased,  ve  concluded  that  the 


eystea  was  marginally  observable  for  a  three-sensor 
configuration  and  unknown  sound  speeds. 

As  a  aeans  of  enhancing  syatea  observability,  it 
was  decided  to  Introduce  more  than  three  sensors  for 
target  tracking. 

He  first  started  with  four  sensors  using  different 
sensor/target  notion  geoaetrles.  Four  cases  were  con¬ 
sidered  end  the  geometries  are  susaurised  in  Figures 
7  to  10. 

Using  the  ssae  philosophy  as  in  the  threesensor  cast 
earller,  we  started  out  by  estimating  one,  two,  three, 
and  then  four  sound  speeds.  For  all  of  these  coses, 
it  was  found  that  we  could  estlaate  the  target  state 
and  up  to  two  sound  speeds  without  obtaining  biased 
eatlaates,  but  as  soon  as  we  attempted  to  estlaate 
three  or  four  sound  speeds,  biases  In  the  estimates 
again  were  noted.  Marginal  systea  observability  again 
was  suspect.  To  substantiate  this  we  looked  at  the 
aigenvaluae  of  the  information  natrlx  as  a  function  of 
time.  The  functional  variations  of  the  eigenvalues  were 
found  to  be  relatively  smooth  and  nonotonlcally  increas¬ 
ing  for  estimation  of  one  or  two  sound  speeds.  An  exam¬ 
ple  of  this  is  presented  in  Figure  11.  It  Involved  the 
target/hydrophone  geometry  defined  by  Figure  10  where 
we  estimated  the  target  state  and  two  of  the  sound 
speeds.  However,  as  we  began  to  estimate  three  and 
more  sound  speeds,  the  function  variation  of  several  of 
the  Information  aatrlx  eigenvalues  becomes  progressively 
more  ill-conditioned  and  lower  in  absolute  magnitude— 
an  indication  that  the  property  of  system  observability 
has  been  weakened. 

To  complete  our  analysis,  we  then  explored  the  use 
of  five  sensors.  Two  geometries  were  selected  and  ere 
shown  in  Figures  12  and  13. 

Using  the  same  approach  as  before,  we  began  by  esti¬ 
mating,  first,  one  sound  speed,  then  two  sound  speeds, 
and  so  on.  Interestingly  enough,  it  was  found  that  one 
could  now  estimate  up  to  three  sound  speeds  before 
biased  estimates  again  occurred. 

For  all  of  the  above  cases  involving  four  and  five 
receiving  sensors,  the  general  observation  was  that  one 
could  estlaate  the  target  state  and  up  to  two  mound 
speeds  for  the  four-sensor  configuration,  and  the  target 
state  and  up  to  three  sound  speeds  for  the  flve-seneor 
configurations. 

Of  course,  these  conclusions  are  baaed  upon  a  finite 
set  of  examples,  and  to  substantiate  the  above  claim 
more  rigorously,  one  would  have  to  Implement  s  more 
exhaustive  set  of  examples. 


• .  1  4.  Conclusions 

In  summary,  it  was  first  noted  that  target  tracking 
vie  extended  Kalman  filtering  tends  to  produce  biased 
estlMtes  when  the  sound  speeds  were  uncertain  and 
incorrectly  specified  in  the  filter.  Attempts  to  addi¬ 
tionally  estimate  the  sound  speeds  were  shown  to  be  of 
no  avail  in  eliminating  these  biases — even  when  apply¬ 
ing  traditional  filter  parameter  variations  that  in  past 
applications  tended  to  sake  the  filter  more  robust  to 
parameter  uncertainties. 

For  this  reason  the  observability  of  the  system  was 
explored  in  greater  detail.  With  the  eld  of  the  informa¬ 
tion  satrlx,  it  was  found  that  the  systea  was  marginally 
observable  over  the  geographical  region  defined  by  the 
three  receiving  sensors. 

Because  of  this,  ve  therefore  took  a  look  at  using 
time-difference  and  Soppier  difference  nessuremente 
from  more  than  three  sensors.  In  particular  we  looked 
sc  configurations  involving  four  and  five  receiving 
tensors. 

The  results  froa  s  finite  set  of  examples  have  shown 
that  tsrget  tracking  performance  is  improved,  l.e.,  very 
small  or  nonexistent  biases,  but  estimation  of  all  sound 
speeds  is  not  possible.  Generally  speaking,  it  saeaa 
that  if  we  vere  given  n>3  receiving  arrays,  it  would 


h*  possible  to  esc  lasts  the  tsrget  stste  end,  st  aost, 
n-2  of  the  sound  speeds  to  osch  of  these  sensors.  The 
remelnlng  two  sound  speeds  heve  to  be  specified  s  priori  l. 
for  the  filter. 
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Figure  2.  Tsrget  motion  ecensrloe  for  sound  speed 
eetlmetlon. 
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Figure  3.  Tsrget  stste  end  sound  speed  eetlmetlon 
(letltude  end  longitude). 
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Figure  4.  Target  state  end  eound  speed  estimation 
(latitude  rate  and  longitude  rate) . 
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Figure  5.  Target  atata  and  eound  epeed  estimation 
(eound  apeede) . 


Figure  t.  Information  oatrlx  eigenvalues— Case  11 
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Figure  7.  Ceometry  of  four  *en»or* — Caa*  1. 
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Figure  8.  Geometry  of  four  sensoTa—Ceee  2 
■  |-x 
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Figure  9.  Geometry  of  four  eeneore — Ceee  3. 


Figure  10.  Geometry  of  four  eeneore— Ceee  4 
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Figure  11.  Information  matrix  eigenvalue*— -target 
etate  end  two  sound  epeede. 


SOUNO  SPEEDS: 
c,  •  4857  FT/SEC 
c2  •  4850  FT/SEC 
ej  *  4870  FT/SEC 
eg  ■  4840  FT/SEC 
eg  >4880  FT/SEC 
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Figure  12.  Geometry  ef  five  eeneore— Ceee  1. 


Figure  13.  Geometry  of  five  eeneore— Ceee  2 


